METHOD FOR MONITORING A MACHINE AND SUCH A MACHINE, 
PARTICULARLY A ROBOT 

FIELD OF THE INVENTION 



The invention relates to a method for monitoring movable 
parts of a machine, such as an industrial robot, as well as 
to a machine with movable parts, such as in particular in- 
dustrial robots. 

BACKGROUND OF THE INVENTION 



The following measures are known for implementing a so- 
called "safe robot": 

limiting the axis or axle speed by software 
restriction; 

limiting speeds by restricting the intermediate circuit 
strain; 

monitoring the speed and/or position via several 
redundant monitoring channels; 

collision monitoring by monitoring the drive moments 
via the motor currents; 



collision monitoring by separate sensor systems, e.g. 
for detecting an approach to obstacles (capacitive, in 
ductive, ultrasonic, visual) or contact forces 
(pressure measuring mats with different physical 
principles) ; 

exclusion of specific parts of the operating area by 
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mechanical stops or by software. 

In part the indicated measures are not safe as the sole 
measures, but only fulfil this requirement in conjunction 
with at least one further monitoring channel and in part 
they are complicated and costly. Thus, generally through a 
multichannel system, i.e. monitoring and making use of sev- 
eral measurements an adequate redundancy is provided. Moreo- 
ver, up to now even a redundant monitoring has involved 
identical or related measured quantities solely being de- 
tected by two or more sensors in the form of measured val- 
ues, which are transmitted and processed by means of sepa- 
rate channels, so that it was only possible to eliminate er- 
rors in the detection, transmission and processing, but not 
with respect to the detected measured or physical quanti- 
ties . 

The problem of the invention is to improve the monitoring of 
a machine, such as an industrial robot, in order to increase 
safety. 

SUMMARY OF THE INVENTION 

According to the invention the set problem is solved with a 
method of the aforementioned type wherein measured values of 
at least two different measured quantities are detected and 
at least one of these measured values is processed to a 
first measure result in such a way that it is comparable 
with the measured value of another measured quantity or a 
second measure result obtained as a result thereof, that the 
first measure result is compared with the measured value of 
another measured quantity or a measure result obtained as a 
result thereof and that a signal characterizing the compari- 
son result is provided. 
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The set problem is also solved by a machine with movable 
parts, such as in particular an industrial robot, character- 
ized by at least two measuring devices for detecting differ- 
ent measured quantities as measured values on movable parts 
of the machine, at least one processing unit for at least 
one measured value of a measured quantity for processing the 
same into a first measure result comparable with another 
measured value of another measured quantity or a second 
measure result obtained therefrom and by a comparison unit 
for comparing the first measure result with at least the 
measured value of another measured quantity or a second 
measure result obtained as a result thereof. 

The measured quantity is the physical quantity to be meas- 
ured and the measured value the direct result of a sensor 
and optionally converter and the measure result is the re- 
sult of a mathematical and in particular electronic process- 
ing of a measured value, particularly in order to obtain a 
starting value with the measured value or a measure result 
of another physical quantity derived therefrom. 

As a result of the invention different or diverse physical 
measured quantities are used for the redxandant monitoring of 
a robot and consequently different measured signals or val- 
ues are made available. This leads to a better, redundant 
and therefore safe monitoring of a machine with movable 
parts, particularly an industrial robot, particularly so as 
to ensure that the machine or the robot in general or in 
situation-dependent manner does not exceed preset speeds, 
which is important for limiting the slowing down path in the 
case of a stop and for limiting the kinetic energy and it 
must also be ensured that robots do not exceed preset accel- 
eration values, which is important for avoiding uncontrolled 
movement states in the case of interference in the control 
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and that finally collisions with obstacles are reliably de- 
tected. 

According to a highly preferred development, e.g. in addi- 
tion to the monitoring of the movement of a robot by motor 
current measurements it is provided that as at least one 
measured quantity material strains on parts of the machine 
are measured or measuring devices are used for determining 
material strains. 

It is particularly important that through the measurement of 
material strains or the construction of a machine or robot 
in such a way that material strains are measured thereon, 
this makes available an additional, differing measuring and 
processing channel, whose measured signal or value is not 
dependent on corresponding values in the machine/robot con- 
trol, such as e.g. stray material measurements, so that in- 
terfering influences do not lead to systematically identical 
or similar errors of measurement in all the different meas- 
uring and processing channels. In addition, the measured 
value obtained from the material strain can additionally be 
used for other purposes . 

In particular the inventive monitoring of material strains 
indirectly makes it possible to monitor the moments of reac- 
tion and forces as a result of collisions, accelerations and 
velocities of motion (centrifugal and coriolis force) , which 
lead to a stressing or loading of the robot structure and 
therefore to the material strains to be measured. 

Preferably material strains are. measured at several points 
of the machine/robot structure and preferably corresponding 
transducers are fitted to at least two sides of a ma- 
chine/robot part, such as the rocker or robot arm and pref- 
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erably on two facing sides, i.e. the top and bottom and 
right and left-hand sides. 

According to a preferred development of the method according 
to the invention, the material strains are measured by means 
of at least one transducer and in particular the material 
strains are measured by means of a strain gauge or material 
strains are measured by means of a light guide-based pickup. 
An inventive machine, such as a robot is, according to a 
further development, constructed in such a way that the de- 
vices for determining material strains are constructed as 
transducers and in particular the devices for determining 
material strains are constructed as strain gauges or the de- 
vices for determining the material strains are constructed 
as piezoelectric or light guide-based pickups. It is funda- 
mentally possible to use different types of transducers, 
i.e. to combine those mentioned hereinbefore. 

As the pattern of the measured quantity to be measured and 
therefore the measured values obtained by the measurement, 
particularly material strains, can be very complex as a re- 
sult of the superimposing of forces and moments, the evalua- 
tion of the sensor information preferably takes place by the 
comparison of reference curves, which can be produced syn- 
thetically by calculation using a corresponding mathematical 
model or by recording the real measured values under known 
conditions and without interfering influences. According to 
another preferred development actual measured values or 
measure results are compared with reference values and in 
particular actual measured values or measure results are 
compared with reference values whilst taking account of tol- 
erances and/or tolerances are taken into account by the for- 
mation of a reference corridor to a reference curve. If the 
measured values or results diverge to a greater than allowed 
extent from the corresponding reference curve, a conclusion 
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can be drawn concerning an unforeseen event, e.g. a colli- 
sion with the operator. The permitted divergence limit is 
defined by a tolerance band (reference corridor) . 

In preferred manner, in the case of divergences of expected 
measured values or results the machine is stopped and in 
particular, as intimated hereinbefore, the measurement of 
material strains for monitoring the movement of a robot 
takes place together with the measurement of other monitor- 
ing quantities as redundant monitoring. 

According to a further development of the machine according 
to the invention, on at least two surfaces of a robot part 
there is in each case a device for determining material 
strains . 

In a preferred development a monitoring device is provided 
and to it is connected a device for determining material 
strains on machine/robot parts. 

The redundancy when testing for unexpected results is ob- 
tained by the simultaneous evaluation of the inventively 
monitored material strains together with at least one fur- 
ther measuring channel and for this purpose use can be made 
of positions and/or velocities determined by software in the 
control means via the path measuring system, as well as mo- 
tor moments, which are measured by means of current sensors 
in the drive amplifiers or boosters. 

Interference freedom can be concluded if none of the redun- 
dant measuring channels indicates an exceeding of the toler- 
ance band. If exceeding is indicated by at least one of the 
measuring channels the robot is stopped by a safe logic and 
brought into a safe state by brakes being locked and drives 
switched into a nondissipative state. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Further advantages and features of the invention can be 
gathered from the claims and the following description of 
embodiments of the invention with reference to the attached 
drawings, wherein show: 

Fig. 1 A block diagram for monitoring the movements of 

a robot. 

Fig. 2 A diagram for determining and evaluating mate- 

rial strains on a machine/robot part. 

Fig. 3 A specific embodiment for determining material 

strains on a machine/ robot as a result of a 
movement about the Al axis . 

Fig. 4 A specific embodiment for determining material 

strains on a robot on the basis of a movement 
about the A3 axis. 

Fig. 5 A robot, whose robot arm comes into contact with 

the shoulder of a person. 

Fig. 6 A robot with a diagrammatic representation of 

the moment of reaction on the acceleration of 
the A3 axis . 

Fig. 7 A robot with diagrammatic representation of the 

centrifugal and coriolis forces occurring during 
a movement about the vertical Al axis . 
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DETAILED DESCRIPTION OF THE DRAWINGS 

Fig. 1 shows a block diagram for performing the inventive 
method of monitoring a robot by means of the reception of 
different, diverse, physical measured quantities by means of 
a rediindant measuring system using the exconple of material 
strains in the structure of an industrial robot 1.5. 

When operating a robot forces and moments can occur in parts 
thereof which lead to material strains within the robot 
parts and which by means of suitaible devices such as strain 
gauges 8 or also not shown, light guide-based pickups and 
which can therefore be monitored during robot operation in 
connection with the divergence from predetermined value pat- 
terns or predetermined/expected value patterns. 

The industrial robot of fig. 1 has a robot base 2, an in- 
verter 3 located thereon, a carrousel 4 rotatable about the 
vertical, first robot axis Al and placed on the base 2, a 
robot rocker 5 pivotably articulated about the horizontal, 
second axis A2, a robot arm 6 pivotably articulated about a 
further horizontal robot axis A3 on its free end remote from 
the rocker 5 and on whose free end remote from the robot arm 
6 is located a robot hand 7 . Strain gauges 8 are located on 
the rocker 5 and robot arm 6 . 

A robot 1 is shown and in block diagram form a monitoring 
device 11. The monitoring device 11 has a monitoring unit 12 
for monitoring elongations of the robot structure, a moni- 
toring unit 13 for monitoring the position of robot parts 
whilst taking account of the chronology and therefore the 
speed, as well as finally a monitoring unit 14 for monitor- 
ing the motor current from the inverters 3 and therefore the 
drive moment . 



The measured values or results measured by the units 12, 13, 
14 are compared with the model values of a model 16 in a 
comparison unit 15 within the framework of the monitoring 
device 11. If the measured values diverge from predeteirmined 
values or a predetermined pattern, a safe disconnection of 
the robot occurs by using an operating or switching device 
17. 

Fig. 2 is a diagram for the determination and evaluation of 
material strains on a machine or robot part. 

For example in the case of a robot, as a result of accelera- 
tions and collisions, (braking, negative acceleration) as a 
reaction thereto occur reaction loading moments M in accor- 
dance with 

M = J*q_dd (1) 

J being the mass moment of inertia and q„dd the angular ac- 
celeration about an axis (step A in fig. 2) . 

This loading moment leads according to 

a = M/W (2) 

in which W is the moment of resistance, to strains on the 
robot structural elements a (step B) . 

In turn, these strains lead according to Hooke's law to 



8 = a/E 



(3) 
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to elongation e on the robot part, E being the modulus of 
elasticity, which can be detected and/or measured using 
strain gauges (step C) . 

The measured elongation values e can now be further proc- 
essed in such a way that the measured elongation values and 
therefore the strain measurements can be compared with other 
measured values of other measured quantities, e.g. motor 
current values (step E) . In a further step F a comparison 
takes place with a further measured quantity F' and in the 
case that both indicate an error, fault, dangerous situa- 
tion, etc., a reliable disconnection occurs (step G) . Addi- 
tionally or alternatively there is a direct evaluation of 
elongations, i.e. the comparison with a reference elongation 
curve (step E') and if the comparison reveals that the meas- 
ure result drops out of the reference elongation curve or 
reference corridor, there is also a safe disconnection (step 
G) . 

Fig. 3 shows that for the determination of the loading mo- 
ments of the robot rocker in the case of a movement thereof 
(and the following robot elements) about the vertical axis 
Al, a strain gauge 8 is located on one side (the right or 
left-hand side of the robot rocker 5) . 

Fig. 4 shows that for the detection of the reaction or load- 
ing moments of a movement about the first, horizontal axis 
A2 a corresponding strain gauge 8 is to be placed on the top 
(or bottom) of the rocker 5. 

Figs. 5 to 7 show specific embodiments of the method accord- 
ing to the invention and a robot, as an example of the ma- 
chine according to the invention with movable parts and the 
monitoring of the machine or robot 1 by the detection of the 
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physical measured quantity the material strain. Fig. 5 also 
diagrammatically shows a person 9. 

If e.g. a robot arm 6 strikes from above, as shown in fig. 
5, the shoulder of a person or strikes from above on another 
object, then there are increased bending moments in the ro- 
bot arm 6 and therefore material strains therein, which can 
be measured by strain gauges 8 on the robot arm 6, particu- 
larly strain gauges . 8 placed on the top and bottom of the 
arm. The same applies in the case of the lateral striking of 
the robot arm against a person or object and in this case 
there are preferably right and left-hand strain gauges 8 on 
the robot arm 6 for material strain measurement. If in the 
direction of the extension of the robot arm 6, the front of 
the latter or a tool connected thereto strikes against an 
obstacle, such as a person, bending moments and therefore 
material strains more particularly occur in the rocker 4. 

As has already been stated in connection with fig. 2 and as 
can be gathered from fig. 5, in the case of an acceleration 
or deceleration of robot axes moments occur in accordance 
with the formula 

M_qi = qi__dd*J 

in which M_qi is the moment of reaction on the acceleration 
of the axis i, in fig. 5 the A3 axis, qi_dd is the angular 
acceleration of the axis i and J the mass moment of inertia. 
These moments lead to material strains which can be detected 
by suitable transducers, such as in particular strain gauges 
or light guide-based pickups. 

Fig. 6 makes it clear that with a constant movement of the 
robot there are centrifugal and coriolis forces correspond- 
ing to 



12 



F_centrif ugal = m • (ci_d)^*r 
or the coriolis force 



F_coriolis = 2*m * (qd x s-d) , 



in which F_centrifugal is the centrifugal force, m the mass, 
g d the angular 



velocity, r the radius, F_coriolis the coriolis force and 
s_d the translatory speed. 

The sensors detecting the resulting material strains provide 
a constant picture of the structural loading during robot 
operation. The measured values obtained can be further proc- 
essed and used in numerous different ways, particularly on- 
line for monitoring and safety purposes, so as to perma- 
nently compare the measured values with predetermined guid- 
ance or limit values so as in this way to ensure the safety 
of the human-machine system, in that movements, namely ve- 
locities or accelerations, are kept within an acceptable 
range and/ or a stoppage occurs if a robot part strikes 
against a human. 

Fig. 7 shows in graph form where the location of a robot is 
plotted against time, shows a reference curve R for a prede- 
termined movement of the robot or a robot part. An accept- 
able range is associated as a reference corridor S with the 
reference curve R. It is also possible to see a measurement 
curve M indicating the actual location of the robot part in 
the case of an operating sequence with respect to time. In 
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area x the measurement curve M moves out of the reference 
corridor S and consequently indicates an inadmissible move- 
ment or collision with unexpected measured values and this 
can e.g. lead to a disconnection of the robot. 



